clc
clear
currentDir = pwd; % 获取当前目录路径
parentDir = fileparts(currentDir); % 获取当前目录的上一级目录路径
% grandParentDir = fileparts(parentDir); % 获取当前目录的上两级目录路径
% greatGrandParentDir = fileparts(grandParentDir); % 获取当前目录的上三级目录路径

%指定需要查找的文件夹
subdir = 'DATA';
%指定需要查找的文件名
filename = '413168000_org.mat';
%构造需要查找的文件的完整路径
full_path = fullfile(parentDir, subdir, filename);
current_data = load(full_path);%当前船舶的ais数据
current_data = current_data.AIS;
% current_data (current_data.Destination ~='CJK',:)=[];
ship_AIS =current_data(:,{'Lon','Lat'});


%但是在绘制航向变化率图片时，使用的是2021-05-01 11:58:08点
index_points_error = [767,768];%绘制图2用的是此点
index_plot=index_points_error(1)-10:index_points_error(2)+15;
% 创建图形，但不显示在屏幕上
% figure(1);
% DrawENC(ship_AIS, 'Original AIS Trajectory');
plot(ship_AIS.Lon(index_plot),ship_AIS.Lat(index_plot),'k-','LineWidth',1);
% 显示网格
grid on;
hold on 

fontSize=8;
fontName = 'Times New Roman'; % 字体名称
index_points_ex=[index_points_error(1)-1,index_points_error(2)+1];
plot(ship_AIS.Lon(index_points_error),ship_AIS.Lat(index_points_error),'ro');
plot(ship_AIS.Lon(index_points_ex),ship_AIS.Lat(index_points_ex),'b*');
% 创建 text
text(122.21607139802, 29.8292365917837,'P2','FontSize', fontSize, 'FontName', fontName);% 
text(122.214604731262, 29.8309891844665,'P3','FontSize', fontSize, 'FontName', fontName);% 

text(122.214331128955, 29.8313031322174,'P1','FontSize', fontSize, 'FontName', fontName);%
text(122.214834731229, 29.8306895322951,'P4','FontSize', fontSize, 'FontName', fontName);%

% legend(['MMSI:' +MMSI],'轨迹突变点');
% legend('船舶轨迹','轨迹急转点');
legend('船舶轨迹','轨迹急转点','相邻轨迹点');

xlabel('经度(°)');
ylabel('纬度(°)');

len_bf = 2;%前窗口大小
len_af = 4;

index_points_bf=index_points_error(1)-len_bf:index_points_error(1)-1;
index_points_af =  index_points_error(2)+1: index_points_error(2)+len_af;
lonlat_bf_window=[ship_AIS.Lon(index_points_bf),ship_AIS.Lat(index_points_bf)];
lonlat_af_window=[ship_AIS.Lon(index_points_af),ship_AIS.Lat(index_points_af)];

% %绘制圆形边界
% lonlat_mean_bf=[mean(lonlat_bf_window(:,1)),mean(lonlat_bf_window(:,2))];%前窗口经纬度的均值
% lonlat_mean_af=[mean(lonlat_af_window(:,1)),mean(lonlat_af_window(:,2))];%后窗口经纬度的均值




% %写文章可以作为示意图使用
% figure
% yline(trueheading_bf_mean, 'b', 'LineWidth', 2); % 前窗口平均航向变化率
% % plot(trueheading_bf_deleta,'b-o')
% hold on
% yline(trueheading_af_mean, 'm', 'LineWidth', 2);  % 后窗口平均航向变化率
% % plot(trueheading_af_deleta,'m-o')
% hold on
% %绘制前后窗口中数据的航向变化率,文中不再使用前后窗口中各个数据的变化率了，而是使用前后窗口各自的平均航向变化率了
% % window_trueheading_deleta=[trueheading_bf_deleta;trueheading_af_deleta];
% % plot(window_trueheading_deleta,'ro-');
% % hold on;
% plot(trueheading_bf_error_deleta,'k-*');
% hold on
% plot(trueheading_af_error_deleta,'k-s');